Modern Robotics, Chapter 10.4: Grid Methods For Motion Planning